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Pie folgenden Angaben sind den vom Anrnelder eingereichteh Unterlagen entnommen 

Priifungsantrag gem. § 44 PatG ist gesteflt 

@> Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters 
© Die vorliegnde Erfindung schafft ein Verfahren zum Er- 
fassen und Kompensieren von kinematischen Verande- 
rungen eines Roboters (10) aufgrund interner und/oder 
externer Einflusse mit den Schritten: Bereitstellen eines 
Robotermodells in Form eines technischen Algorithmus 
mit einem oder mehreren festgelegten Paramtern, wel- 
che die theoretische raumliche Stellung des Roboters (10) 
in Abhangigkeit von einer oder mehreren Steuergroften 
beschreibt; Steuern der theoretischen raumlichen Soli- 
stellung des Roboters mit einer Robotersteuerung (100) 
gemafc dem Robotermodell; Erfassen der tatsachlichen 
raumlichen Iststellung des Roboters (10) im Betrieb durch 
eine Sensoreinrichtung (K 1f K 2 ; 50); Erfassen der kinema- 
tischen Veranderungen anhand der Abweichung der er- 
fafcten tatsachlichen raumlichen Iststellung des Roboters 
i (10) von der theoretischen raumlichen Sollstellung des 
, Roboters (10); Anpassen des oder der Parameter des Ro- 
i ' botermodells zum Kompensieren der kinematischen Ver- 
anderungen unter Berucksichtigung der erfafSten Abwei- 
chung; und Steuern der theoretischen raumlichen Soll- 
stellung des Roboters mit der Robotersteuerung (100) ge- 
mate dem Robotermodell mit dem oder den angepaSten 
Para mete rn. 
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DE 198 26 395 A 1 

Beschreibung 

ErfindungsgemaB wird diese Aufgabe durch das in Anspruch 1 angegebene Verfahren eelost 

Die Erfiwsiin* rJr S i, andernder Randbedingungen bzw. trotz zunehmendem VersehleiB erhalten 

J^SSSSS^S^ deren K ° m P enSation im «* entweder im ReaJbetneb odert Si mU - 

Ve^enY nteranSPriiChen finden ^ V ° rteilhafte Weit -bildungen und Verbesserungen des in Anspruch 1 angegebenen 

Von der oder den SteuergrdBen nut einer bestimmter ?5£$g& ReferenZ P unk *» » Abhangigkei,. 
GemaB emer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens eine Kamera verwendet, 
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welche extern aufgestellt ist. 

GemaB einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens ein Lageerfassungssen- 
sor verwendet wird, welcher an der Roboterhand angebracht ist. 

GemaB einer weiteren bevorzugten Weiterbildung wird das Erfassen der kinematischen Veranderungen anhand der 
Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters von der theoretischen raumlichen Sollstel- 5 
lung des Roboters an den Referenzpunkten durchgefiihrt, indem ein jeweiliger Korrekturvektoren zwischen der erfaBten 
tatsachlichen raumlichen Iststellung des Roboters und dem entsprechenden Referenzpunkt eingefuhrt wira\ 

GemaB einer weiteren bevorzugten Weiterbildung wird die tatsachlichen raumliche Iststellung des Roboters im Be- 
trieb durch die Sensoreinrichtung mittels eines am Roboter angebrachten MaBkorpers ermittelt wird. Durch die MaBkor- 
pervermessung werden die Basis und das Tool unabhangig von der eigenen Kinematik des Roboters geschatzt, und somit 10 
gehen auch seine Fehler nicht in die Schatzung ein. 

GemaB einer weiteren bevorzugten Weiterbildung wird die Gute der im Betrieb durch die Sensoreinrichtung erfaBten 
tatsachlichen raumlichen Iststellung des Roboters ermittelt wird und das Anpassen davon abhangig gemacht wird. Somit 
gehen als Import fur die Parameteranpassung nur gultige bzw. zuverlassig ermittelte Daten ein, und AusreiBer sind eli- 
minierbar. 15 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Ermitteln der Giite durch Bereitstellen eines MaBkorpers 
mit Markern am Roboter; Festlegen eines inneren Koordinatensystems auf dem MaBkorper und der entsprechenden Ko- 
ordinaten der Marker; Erfassen der Koordinaten der Marker im Weltkoordinatensystem durch die Sensoreinrichtung; op- 
timiertes Abbilden der Koordinaten der Marker im inneren Koordinatensystems auf die Koordinaten der Marker im 
Weltkoordinatensystem und durch Ermitteln der Gute anhand des mittleren Fehlers der Abbildung. Diese Vorgehens-. 20 
weise liefert eine qualitative Aussage uber die Gute der MeBdaten. 

Ausfuhrungsbeispiele.der Erfindung sind in den Zeichnungen dargestellt und in der nachfolgenden Beschreibung na- 
her erlautert. 

Es zeigen : 

Fig. 1 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsforrn des 25 
erfindungsgemaBen Verfahrens; 

Fig; 2 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer zweiten Ausfuhrungsforrn 
des erfindungsgemaBen Verfahrens; und 

Fig. 3 eine Darstellung der Haufigkeit von MeBabweichungen beim ublichen Verfahren im Vergleich zur- zweiten Aus- 
fuhrungsforrn des erfindungsgemaBen Verfahrens. I . 30 

In den Figuren bezeichnen gleiche Bezugszeichen gleiche oder funktionsgleiche Komponenten. 

Fig. 1 zeigt eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsforrn 
des erfindungsgemaBen Verfahrens. 

In Fig. 1 bezeichnet Bezugszeichen 10 einen an seinem Einsatzort fest montierten Roboter, 15 einen Roboterarm, 18 
eine (verdeckte) Roboterhand, 20 einen MaBkorper, R Referenzpunkte auf dem MaBkorper 20, 50 einen Lageermitt- 35. 
lungssensor, welcher. mit dem MeBpunkt 55 zusanimenwirkt, K x und K 2 eine erste bzw. zweite externe Kamera, welche 
den MaBkorper in ihrem gemeinsamen Sichtbereich haben, 100 eine Robotersteuerung und 120 einen Hostrechner. Die 
Roboterhand 18 ist zusatzlich mit einem (nicht. gezeigte) Werkzeug, z. B. einern MeBvideosensor, bestuckt. Mit diesem 
Systemaufbau ist man prinzipiell in der Lage, einerseits mit. dem Roboter 10 Messungen vorzunehmen und andererseits 
die Position und Orientierung des MaBkorpers 20 zu bestimmen. 40 

In Form eine Steuerprogramms existiert. in der Robotersteuerung ein Robotermodell in Form eines technischen bzw. 
physikalisch/mathematischen Algorithmus mit einem oder mehreren festgelegten Parametern, welches die theoretische 
raumliche Stellung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroB en beschreibt. Als Parameter 
kommen beispielsweise Linklangen, Achsenschiefstande, Nullpunktfehler, Gelenklose, Geienkelastizitaten usw. in 
Frage. . 45 

Mittels dieses Modells und einer entsprechend modifizierten Kinematik ist der Roboter 10 in der Lage, kartesische Po- 
sition en in seinem Arbeitsraum mit hoher Genauigkeit zu erreichen. 

Im folgenden wird naher erlautert, wie der oder die Parameter fur das Robotermodell fest.gelegt werden. Zum Zeit- 
punkt. der Inbetriebnahme befindet. sich der Roboter 10 in einer bestirnmten kinematischen Konfiguration, die von den 
besagten internen und externen EinfluBfaktoren abhangig ist. Diese Referenzkon figuration wird uber eine Referenzmes- 50 
sung festgehalten, indem der MaBkorper 20 an ausreichend vielen raumlichen Roboterstellungen (entsprechend Refe- 
renzpunkten ai mit i = 1 . . . n), welche durch die SteuergroBen bestimmt. werden, durch die eine erste und zweite externe 
Kamera Ki bzw. K 2 vermessen wird. Darauf erfolgt das Festlegen des oder der Parameter derart, daB das Robotermodell 
die raumliche Stellung des Roboters 10 an den Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit ei- 
ner bestirnmten sehr hohen Genauigkeit beschreibt. Hoch bedeutet. dabei, daB die Genauigkeit groBer ist als die aufgrund 55 
der kinematischen Veranderungen auftretenden Schwankungen. 

Andert sich nun die Referenzkonfiguration, d. h. treten kinematische Veranderungen des Systems auf, werden die Re- 
ferenzpunkte aj nicht. mehr mit der sehr hohen Genauigkeit anfahrbar sein, welche durch die Referenzmes sung sparame- 
ter bestimmt ist, sondern es werden sich Abweichungen zwischen Soil- und Istwerten ergeben, welche mittels der beiden 
Kameras Ki, K 2 und/oder dem Lagesensor 50 erf aBt werden: 60 

Aufgrund der jeweiligen Abweichung zwischen Sollwert Fi, und Istwert F*j wird eine Anpassung des oder der Para- 
meter des Robotermodells ausgelost, namlich bei dieser Ausfuhrungsforrn, wenn die erfaBte Abweichung einen vorbe- 
stimmten Wert iiberschreitet. 

Diese Anpassung geschieht dadurch, daB ein jeweiliger Korrekturvektoren T- zwischen der erfaBten tatsachlichen 
raumlichen Iststellung F*i des Roboters 10 und dem entsprechenden Referenzpunkt als Sollwert F { eingefuhrt wird. Es 65 
gilt dabei die funktionelle Beziehung: . 

T(M,a L ) • Ti = Fi (1) , 
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% K K^ tU T ktOTen u Ti ^ n / ehlerT CM, aO" 1 Fj zwischen dem theoretischen Sollwert T(M, aO und der Referenz 
messungFibeschreiben, wobei M das ursprungUche ComputermodeU ist 2 

UU^T? Anpass 0 un « ^ es L teht nun darin > daB urspriingUche RobotermodeU M mit dem oder den urspriingli- 

chen Parametern in ein angepaBtes RobotermodeU M* mit einem oder mehreren angepaBten Parametern umzuwandeln 
Diese Aufgabe fuhrt aufein nicht-Uneares Minimierungsproblem der Form- 



n 



!jT(M*, ai ) - F--T- 1 ! 2 = min. {2) 



10 



Die Losung dieses Mmimierungsproblems erfolgt zweckmaBigerweise mittels der Gaufi-Newton-Methode 
■nftEi « I def Ko ™kturvektoren gelingt es also, die Fehler zu quantisieren und zu kompensieren, welche 
auf kinematischen Anderungen der Referenzkonfiguration beruhen. Dabei werden nicht die EinfluBfaktoren sonaem de- 
is 

h^Zf^ T° the °5 eti f hen raumlichen SoUsteUung des Roboters mit der Robotersteuerung (100) gemaB dem Ro 

XS^SS^S^^ Parametem ^ dann S ° lange ' MS ^ erfa6te " Abwelchnnlen eine erneute 

be^SI^? 6 v ildUng /, er Aus fiihrungsform wird nun eine robuste und reproduzierbare Prozedur angege- 

ben, durch d e die Position und die Onentierung eines MaBkorpers bzw. MeBwerkzeuges im kartesischen Raum hochge- 

MeBmTrkmlT ^ ^ ^f" neben - den MeB ~ ein internes Koordinatensystem, in dem dL 

MeBmerkmale a prion bestimmt wurden, als EingangsgroBen. Im weiteren Verlauf der Prozedur entsteht eine Koordina- 
SrThaS^^^ -ni MeBwerkzeugskoordinatensystem durch ^ op^A^ 

li P ?T I r ^ ie b hl Cannten t h u ™t der .MeBmerkmale untereinander wird die Gate der MeSdaten laufend eindeutig kontrol- 
liert, also nicht niir nach ihrer PlausibiUtat, sondetn genau quantisierbar. Somit konnen AusreiBer der MeBdaten tonkret 

t tnf c r SSenen raUI f chen Position des Rioters ™> eliminiert werden und verhindert werder daB S 

tumhcherweise eine Anpassung des oder der Modellparameter auslosen 

mJlT^^ b< T^ der ^ aBk6l P er aus einer ^bilen Vorrichtung zum Anbringen von MeBmerkmalen (sog. Marker) 
merbei sind verschiedene Vanationen von einer Metallplatte bis hin zu einzelnen Verstrebungen vorsteUbar. Wichrig ist 
allein die geometnsche Invananz, also Stabilitat gegeniiber Verformungen vvicnug 
H JS? if 6 "? K ° ordinatens y stem b zw. MeBwerkzeugskoordinatensystem des MaBkorpers entsteht aus einer Messung 
der MeBmerkmale die darauf ,n ausreichend groBen Abstanden angebrachi sind. Diese Messung erfolgt unter op Sen 
tnf d - fe «f ^erpositionen im internen Koordinatensystem mit wiUkurUch 
Erne Schatzung liefert die Position und Onentierung des MaBkorpers, der am Roboter 10 angebracht ist beziiglich des 
Weltkoordinatensystems, wie z. B. erfaBt durch die externeri Kameras Kl und K 2 . Die extern erfaBten MeBwerte v Widen 
nut den entsprechenden bekannten Koordinaten x ; des internen Koordinatensystems die Eingang StofflTESS? 

^^S^L^^^ISS^ 3bbildef - ^ eser Ansatz .UBt sieh mi, der Methode der 
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S jACa^b.cocP^jXi - Yi | 2 = min . (3) 



Der mittlere Fehler der Abbildung liefert dann ein MaB fur die gesuchte Giite 
fences a^KSSS^-SSf 1 * dneS R ° b0terSyStemaUftaUS ™ Erla — « -er zweiten AusfUhrungs- 
• ^ 2 b fJ* ic h^ii 2us a tzUch zu den bereits eingefuhrten Bezugszeichen KC eine Kamerasteuerungs/-auswertune- 
einnchtung, 150 einen MeBvideosensor, 200 ein MeBobjekt. in Form einer Fahrzeugkarosserie und PA eZ 2- 
sensorsteuerungsAauswertungeinrichtung. ■ meDVlaeo 

„n^ r ^n i8 ' t 2 ^ ' e fy. 516 "] 2 ^ 311 dient zur genauen Vennessung der Fahrzeugkarosserie 200 mil dem Mefivideo- 
sensor 150 unter Manipulation durch den Roboter 10. 

.nn^f c Ch p St >T? rde i e n n R °b° u ,ermode11 mit mehreren festgelegten Parametem, welches die theoretische raumliche Stel- 
lung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroBen beschreibt, vorgegeben Es erfS dinn 
,™d U M rn d f H th h eoretlsch 7 en SoUsteUung des Roboters mit der Robotersteuerung 100 gemaB dlSS RoS 

termodeU und dabei eine Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150 ■ 
worfen 11 W ° aufgebaute MeBsystem thermischen StreBfahrten mit einem Temperaturhub von 20°C unter- 

«orpW 0l hf einE £ assen dei ^tatsachlichen raumlichen IststeUiing des Roboters 10 im Simulationsbetrieb durch die Sen- 

T£Z "I d ^ K T f e u aS K " K2 - WiC emartet er « abt Sich das Vorhandensein kinematischer Verandemngen 

J™ de ^ h ;™ lsch en StreBfahrten. Es folgte eine erneute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvi- 
deosensor 150 (unkompensierte Daten in Fig. 3). menvi 

„n!: S S 5 ^^ darauf An P assen der Parameter des Robotermodells zum Kompensieren der kinematischen Veranderungen 

SSS5£?'? " n AbWei o Ch u ng Und Cin SteUem der tbeoredschen raumlichen SoUstellung de^ SK 
ters mu der Robotersteuerung gemaB dem RobotermodeU mit dem oder den angepaBten Parametern und dabei eine er 
neute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150 (kompensierte Daten n Fig 3) 

F,g. 3 zeigt eine Darstellung der Haufigkeit von MeBabweichungen beim ublichen Verfahren im Vergleich zur zweiten 
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Ausfuhrungsform des erfindungsgemafien Verfahrens. 

Wie deutlich aus Fig. 3 erkennbar, zeigen die unkompensierten Daten eine Abweichung von bis zu etwa 0,390 mm ge- 
genuber der ersten Messung vor den thermischen S treBfahrten. Demgegeniiber zeigen die kompensierten Daten lediglich 
eine Abweichung von bis zu etwa 0,125 mm gegenuber der ersten Messung vor den thermischen StreBfahrten. Die Kom- 
pens ation schafft also eine Verb esserung um einen Faktor 3. £ 5 

Obwohl die vorliegende Erfindung vorstehend anhand bevorzugter Ausfuhrungsbeispiele beschrieben wurde, ist sie 
darauf nicht beschrankt, sondem auf vielfaltige Art und Weise modifizierbar. 

Insbesondere sind genannten Anwendungen nur beispielhaft und beliebig verallgemeinerbar. Auch ist die Positionser- 
fassung nicht auf Kameras beschrankt. Der MaBkorper muB nicht ein selbstandiger Korper sein, sondern kann in den Ro- 
boter integriert sein. Auch die genannten Algorithmen dienen nur Illustrationszwecken und konnen durch andere geeig- 10 
nete Optimierungsalgorithmen ersetzt werden. 

Bezugszeichenliste 

10 Roboter 15 
100 Robotersteuerung 
50 Sensor 

55 MeBpiinkt fur Sensor 50 
15 Roboterarm 

18 Roboterhand 20 
20 MaBkorper 
Ki Kamera 1 
K 2 Kamera 2 

£C Kamerasteuerungs/-auswertungeinrichtung 

150 MeBvideosensor 25 

200 MeBobjekt, Fahrzeugkarosserie 

PA MeBvideosensorsteuerungsAauswertungeinrichtung 

R Referenzpunkt. auf 20 

120 Hostrechner £ 

X- .30 

Patentanspruche 

1 . Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters (10) aufgrund in- 
terner und/oder externer Einflusse mit den Schritten: 

Bereitstellen eines Robotermodells in Form eines technischen Algorithmus mit eiriern oder mehreren festgelegten 35 
Parametem, welches die theoretische raumliche Stellung des Roboters (10). in Abhangigkeit.von einer oder mehre- 
ren Steuergro Ben beschreibt; 

Steuern der theoretischen raumlichen Sollstellung des Roboters mit einer .Robotersteuerung (100) gemaB dem Ro- 
botermodell; 

Erfassen der tatsachlichen raumlichen Iststeilung des Roboters (10) im Betrieb durcb eine Sensoreinrichtung (Ki, 40 
K 2 ; 50) 

Erfassen der kinematischen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststei- 
lung des Roboters (10) von der theoretischen raumlichen Sollstellung des Roboters (10); 

Anpassen des oder der Parameter des Robotermodells zum. Kompensieren der kinematischen Veranderungen unter 
Beriicksichtigung der. erfaBten Abweichung; und 45 
Steuern der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung (100) gemaB dem Robo- 
termodell mit. dem oder den angepaBten Parametern. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB das Anpassen des oder der Parameter des Robotermo- 
dells zur Korrip ens ation der kinematischen Veranderungen unter Berucksichtigung der erfaBten Abweichung er- 
folgt, wenn die erfaBte Abweichung einen vorbestimmten Wert uberschreitet. 50 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, daB das Bereitstellen eines Robotermodells in Form 
eines technischen Algorithmus mit einem oder mehreren festgelegten Parametern folgendermaBen erfolgt: 
Anbringen eines MaBkorpers (20) an der Roboterhand (18); 

Erfassen der tatsachlichen raumlichen Iststeilung des MaBkorpers (20) durch die Sensoreinrichtung (K ls K 2 ; 50) an 
einer Vielzahl von durch den. einen oder die mehreren SteuergroBen bestimmten Referenzpunkten; und 55 
Festlegen des oder der Parameter derart, daB das Robotermodell die raumliche Stellung des Roboters (10) an den 
Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

4. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 
(Ki, K 2 ; 50) mindestens eine Kamera (K u K 2 ) verwendet wird, welche extern aufgestellt ist. 

5. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 60 
(Ki, K 2 ; 50) mindestens. ein Lageerfassungssensor (50) verwendet wird, welcher an der Roboterhand (18) ange- 
brachtist. 

6. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB das Erfassen der kinemati- 
schen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststeilung des Roboters (10) 
von der theoretischen raumlichen Sollstellung des Roboters (10) an den Referenzpunkten durchgefuhrt wird, indem 65 
ein jeweiliger Korrekturvektoren zwischen der erfaBten tatsachlichen raumlichen Iststeilung des Roboters (10) und 
dem en tsprechenden Referenzpunkt eingefuhrt wird. 

7. Verfahren nach einern der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB die tatsachlichen raumliche 
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?Sr g m S !5? 0tera 2£ im BCt ? eb dUrch die Sens °™c.htung .(Kt, K 2 ; 50) mittels eines am Roboter (10) an- 
gebrachten MaBkorpers (20) emuttelt wird. 

8. Verfahren nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet, daB die Gute der im Betrieb 
durch diej>ensoremnchtung (K u K 2 ; 50) erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) ermittelt 
wird und das Anpassen davon abhangig gemacht wird. ~ 

9. Verfahren nach Anspruch 8, dadurch gekennzeichnet, daB das Ermitteln der Gute folgendermaBen erfolgf 
BereitsteUeneinesMa6korpers(20)mitMarkern(R)amRoboter(10)- g 
^sdegen eines inneren Koordinatensystems auf dem MaBkorper und der entsprechenden Koordinaten der Marker 

Erfassen der Koordinaten der Marker (R) im Weltkoordinatensystem durch die Sensoreinrichtung (Kj, K 2 ; 50)- op- 
hrmertesAbbildender Koordinaten der Marker (R)im inneren Koordinatensystems auf me Koordinaten der M^ki 
(K; im Weltkoordinatensystem; und 

Ermitteln der Gute anhand des rnittleren Fehlers der Abbildung 

10. Robotersteuerung (100) zur Durchruhrung des Verfahrens nach mindestens einem der vorhergehenden Anspru- 
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